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Basically, human can sense the active body force trough the soles of their 
feet and can feel the position vector of zero moment point (ZMP) based on 
the center of pressure (CoP) from active body force. This behavior is adapted 
by T-FLoW humanoid robot using unique sensor which is piezoelectric 
sensor. Piezoelectric sensor has a characteristic which is non-continuous 
reading (record a data only a moment). Because of it, this sensor cannot be 
used to stream data such as flex sensor, loadcell sensor, and torque sensor 
like previous research. Therefore, the piezoelectric sensor still can be used to 
measure the position vector of ZMP. The idea is using this sensor in a special 
condition which is during landing condition. By utilizing 6 unit of 
piezoelectric sensor with a certain placement, the position vector of ZMP (X- 
Y-axis) and pressure value in Z-axis from action body force can be found. 
The force resultant method is used to find the position vector of ZMP from 
each piezoelectric sensor. Based on those final conclusions in each 
experiment, the implementation of foot pressure sensor modul using 
piezoelectric sensor has a good result (94%) as shown in final conclusions in 


each experiment. The advantages of this new foot pressure sensor modul is 
low-cost design and similar result with another sensor. The disadvantages of 
this sensor are because of the main characteristic of piezoelectric sensor 
(non-continuous read) sometimes the calculation has outlayer data. 
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1. INTRODUCTION 

Generally human behavior was adapted in many systems which has special requirement in each part 
such as mechanical design (body design, kinematics, dynamics, or mechanic characteristic) and control 
design (PID control, fuzzy control, or neural network). In T-FLoW humanoid robot system has several 
special requirements. T-FLoW humanoid robot is humanoid robot from EEPIS Robotics Research Center 
(ER2C) Laboratory. T-FLoW humanoid robot has 28 Degree of Freedom (DoF) version and teen size of 
mechanical body. In the development of T-FLoW humanoid robot, there is one behavior which will adapted 
by T-FLoW humanoid robot and will discuss in this paper as shown in Figure 1. This behavior is sense the 
active body force trough the soles of their feet. In humanoid robot, the behavior to sense the active body 
force trough the soles of the feet are same as with directly measuring the position vector of Zero Moment 
Point (ZMP) based on Center of Pressure (CoP) [1-3]. 

In previous research, there are several sensors which normally used in humanoid robot such as Force 
Sensing Resistant (FSR) sensor [4, 5], LoadCell sensor [6], and F/T sensor and several methods to obtain the 
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position vector of ZMP based on the sensor usage such as fuzzy and clustering (AI) [7-13]. Based on 
previous research before, this paper will discuss about how to measure the position vector of ZMP using a 
unique sensor which is piezoelectric sensor. 


(a) (b) 


Figure 1. T-FLoW humanoid robot (a) Serial mechanism version (20 DoF) (b) Parallel mechanism version 
(28 DoF) 


Piezoelectric sensor is very unique sensor which has a characteristic non-continuous reading (record 
a data only a moment) when receive a single continuous pressure (non-polarization process) [14-31]. 
Because of it, this sensor cannot be used to stream data such as flex sensor, loadcell sensor, and torque sensor 
like previous research [7—13]. Therefore, the piezoelectric sensor still can be used to measure the position 
vector of ZMP. The idea is using this sensor in a special condition which is during landing condition. By 
utilizing 6 unit of piezoelectric sensor with a certain placement, the position vector of ZMP (X-Y-axis) and 
pressure value in Z-axis from action body force can be found. The force resultant method is used to find the 
position vector of ZMP from each piezoelectric sensor. Because the sensor placement is fixed, the force 
resultant method can be used to find the position vector of ZMP (X-Y-axis) and pressure value in Z-axis. 


2. RESEARCH METHOD 

The research method is describing about why and how the piezoelectric sensor is used to gain the 
position vector of ZMP based on CoP. Research method has several sub-sections which is piezoelectric 
sensor characteristic, piezoelectric sensor usage, resultant force method, design of foot sensor module, and 
hardware overview. 


2.1. Piezoelectric sensor characteristic 

Piezoelectric sensor has different characteristic with another pressure sensor as mentioned before. 
This section will explain about piezoelectric sensor characteristic. Piezoelectric is a material which transform 
the energy from mechanical domain into electrical domain or electrical domain into mechanical domain. This 
transformation process is called piezoelectric effect. Piezoelectric effect has 2 conditions based on transform 
domain. The example of piezoelectric effect is when piezoelectric material is applied with electricity 
(electrical domain), the piezoelectric material will vibrate (mechanical domain) and causing a sound. Another 
example is when piezoelectric material is applied with pressure, touch, or vibration (mechanical domain), the 
piezoelectric material will generate an electricity (electrical domain) with dynamic range based on the 
frequency and how strong the applied pressure, touch, or vibration. 

Piezoelectric effect which has relation with this discussion is when piezoelectric material as shown 
in Figure 2 is transform the mechanical domain into electrical domain. The mechanical domain in this 
discussion is pressure force in the soles of the feet caused by active body force and the electrical domain is 
electricity which generated by piezoelectric material based on the applied pressure force as shown in 
Figure 3. 
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Figure 3. Piezoelectric sensor disc receives pressure force 


The relation between pressures forces with generated electricity in piezoelectric sensor is shown 
in (1) shown based on Figure 3. 


Cpp D 
Vout,pp = ( PD PD EA P Fppa (1) 
Where: 


Cpp = d33 = 135 100 M/y 
CE, = £33 x £0 = 800 x 8.854 107! = 7083.2 10722 F/m 


AEpp = Tr? = 3.14 x 0.9? = 2.5434 cm? 
Dpp = 0.2mm = 0.02cm 


Where Fpp 4 is applied pressure force. Dpp is thickness of piezoelectric sensor. AEpp, ACpp, and 
AMpp is wide area of piezoelectric electrode, material, and metal. Cpp and Cfp is piezoelectric constant 
(based on material). Vout pp is generated voltage caused by applied pressure force 


2.2. Piezoelectric sensor usage 

Based on the characteristic of piezoelectric sensor, this section will explain about how to use this 
sensor to obtain the pressure data. When piezoelectric material is used to transform the data from mechanical 
domain (pressure) into electrical domain (electricity), the pressure force must have a non-continuous pressure 
(polarization process/several pressure in a time domain) to generate a continuous electricity as shown in 
Figure 4. If the pressure force is continuous pressure (non-polarization process/single continuous pressure), 
the piezoelectric sensor has a single data reading with dynamics pick based on the how big applied pressure 
force as shown in Figure 5. 


Time (t) 


Time (t) 


Figure 4. Comparison between non-continuous pressure (polarization process/several pressure in a time) with 
generated electricity of piezoelectric sensor 
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Figure 5. Comparison between continuous pressures (non-polarization process/single continuous pressure) 
with generated electricity of piezoelectric sensor 


Because of it, the piezoelectric sensor has opposite usage and opposite characteristic from another 
pressure sensor such as FSR, LoadCell, and F/T sensor. Therefore, the piezoelectric sensor still can be used 
to obtain the position vector of ZMP as result of this discussion. The idea to achieve this result is, the 
piezoelectric sensor is used in a special condition as seen in Figure 5. The special condition is during landing 
condition (when feet of legs is touching the ground/base). As seen in Figure 5, the special condition has 
unequal data with highest and lowest peak. The data must be reconditioned to obtain the average data (2). 
The (3) is used to obtain the real applied pressure force (Fpp y) from average data of piezoelectric sensor 


(Vout, av PD). 
Vout,PD, 
Vout,Av,PD = O a Pureo AT pp (2) 
CE, AE, 
Fopm = ( nee ae Dep) Vout,av,PD (3) 


Where Vout Av, pp is piezoelectric sensor average output. Vout ppa and Vout, ppg is upper and lower 
limit. AT pp is the difference between upper and lower limit. Fpp y is real applied pressure force from average 
data of piezoelectric sensor (Vout, 4v,pp).The piezoelectric sensor is placed in the soles of the feet. To obtain 
the position vector of ZMP, at least needs 3 unit of piezoelectric sensor [19]. In this discussion, T-FLoW 
humanoid robot will utilize 6 unit of piezoelectric sensor with a certain placement (fix placement). The data 
from these piezoelectric sensors (Vo, pp) is combined and processed by using resultant force method to 
obtain the position vector of ZMP (X-Y-axis) and pressure value in Z-axis from action body force can be 
found. 


2.3. Resultant force method (non-parallel) 

Sometimes, a force usually has a certain angle (@p;) from normal axis (X-Y-axis). The resultant 
force is how to transform this kind of force into force vector (X-Y-axis). The resultant force method has 2 
kinds of calculation based on the force angle which can be seen in Figure 6 and Figure 7. 


Fr3 


Frix FR,2x FR3x 


Figure 6. Resultant force calculation with uncertain force angle 
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Figure 6 is explaining about the scalar force (Fp;) with uncertain angle(@p;). This kind of scalar 
force has several force vectors based on scalar force value (Fr; ) and the force angle(@p;). Because of it, the 
force vector (Fp i (x,y)) of this model is not linear (4). 


(4) 


Figure 7. Resultant force calculation with certain force angle 


Figure 7 is explaining about the scalar force (Fp ;) with certain angle (gi). This kind of scalar force 
has force vectors only based on scalar force value(Fp;). Because of it, the force vector (Fri cx,yy) of this 
model is linear with scalar force value Equation (5). 


Ori = Fix value (5) 


To transform the scalar force(Fp ;) into force vector (Fricx,y)) is used (6). The equation can be used 
to calculate both of resultant force models above. The resultant force calculation with certain force angle 
model is used in this discussion because it has a fix position (fix force angle). 


x cos? 6p; 
Fri ll T [ru ees a (6) 


2.4. Design of foot sensor module 

As mentioned before, the resultant force method is used to calculate the position vector of ZMP 
based on CoP from 6 unit of piezoelectric sensor. Each sensor has fixed placement in the soles of the robot 
feet as seen in Figure 8. 


Figure 8. Piezoelectric sensor placement in the T-FLoW humanoid robot feet (A) Top view of design (B) 
Bottom view of T-FLoW feet 
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Piezoelectric sensor will measure the vertical pressure force which happen in the feet of robot. To 
generate the position vector of ZMP and pressure value in Z-axis, each sensor is calculated by using 
Newton’s Law with force resultant equation which explained in (7) or in (8~13). 


x F sin™ ppi 
Ppp, p = | 2P% | cos™t Opp i (7) 
Z 


Where Ppp; is resultant force vector (X-Y-Z-axis) in a piezoelectric sensor. Fpp; is force value 
which applied in a piezoelectric sensor. Opp; is certain angle of piezoelectric sensor point to the origin point 
of the robot feet. i is the number of piezoelectric sensor in T-FLoW humanoid robot. 

To obtain the force resultant in piezoelectric sensor 1 (Ppp 1): 


x F ee | 
PD,M,1 2 
Pepa b = cos~* Opp1 (8) 
a Fpp,m,1 
To obtain the force resultant in piezoelectric sensor 2 (Ppp 2): 
x F : in? 9pp,2 
PD,M,2 = 
Ppp,2 p = cos~* Opp,2 (9) 
á Fpp,m,2 
To obtain the force resultant in piezoelectric sensor 3 (Ppp 3): 
. —1 8 
x F SIN ~ Upp3 
Ppp,3 p = | 223 | cos7t Opp 3 (10) 
a Fpp,m,3 
To obtain the force resultant in piezoelectric sensor 4 (Ppp 4): 
. -1 8 
x F sın PD,4 
Popa p = | PPA | cos7t Opp (11) 
Z Fpp,m,4 
To obtain the force resultant in piezoelectric sensor 5 (Ppp 5): 
. -1 f] 
x F sın PD,5 
»M,5 - 
Pops p a |e ae Opps (12) 
Z FPp,m,5 
To obtain the force resultant in piezoelectric sensor 6 (Ppp ¢): 
. —1 8 
x F SIN  Upp,6 
Pepe p = | P08 | cos- OPp,6 (13) 
Z 


Fpp,m,6 


Based on the calculation of force resultant in each piezoelectric sensor point, the position vector of 
ZMP (Ppp x,y,z) based on CoP will be obtained by using (14-16): 


Ppp x = (Pepa + Pep (x) + Pepa) — (Pepa x) + Pros x) + Pepe -x)) (14) 


Pepy = (Pen) + Pros œ) + Peo œ) — (Pen,2 y) + Pens y) + Proacy)) (15) 
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MAS ee 
Ponz = Lint sas (16) 


Where Poppi, Ppp2, Ppp3, Ppp, Ppp,s, and Ppp, is resultant force vector (X-Y-Z-axis) of 
piezoelectric sensor in each point of feet. Fpp m1, Fpp,m,2» Fpp,m,3> Fpp,m» Fpp,m,s» and Fpp,m,6 iS pressure 
force value which applied in each piezoelectric sensor. 9pp 1, Opp.2, 9pp,3> Ppp,4» Opp,s, and Oppe is certain 
angle in each piezoelectric sensor point to the origin point of robot feet. Ppp x» Ppp y» Pppz 18 position vector 
of ZMP based on CoP. 


2.5. Hardware framework of foot sensor module 

The hardware framework of foot pressure sensor module is shows in Figure 9. Where the output of 
piezoelectric sensor (Vout,avpp) as input for the SLAVE block. The SLAVE block is a hardware with 
integrated micro-processor such as AVR or ARM. The data from piezoelectric sensor (Vout, Av,pp) iS 
processed by using resultant force method to obtaining the position vector of ZMP (Ppp x,y,z)) and send it 
through serial communication (UART) to the MASTER block. MASTER block is a hardware with high 
speed clock such as mini-PC or laptop. 


Vout,PDeu.A : MASTER 


Vout,PDpL.2 


t 
2 
= 
3 
O 
< 


SLAVER, & 


Vout,PDain 


Vout PDypA 
Vout,PD p12 


AD Converter 


Vout,ppyin 


Figure 9. Hardware framework and comunication process 


3. RESULTS AND ANALYSIS 

This section is explaining an implementation results of foot sensor modul using piezoelectric sensor. 
Several experiments such as walk in place, walk in place with forward force disturbance, and walk in place 
with right side force disturbance was implemented into T-FLoW humanoid robot. In the explanation in sub- 
section, the analysis is focused into the main issue of disturbance. During walk in place experiment, the 
analysis is focused in the position vector of ZMP based on CoP calculation in the X-axis. It is because the 
position vector of ZMP based on CoP in Y-axis is undominant. During walk in place with forward force 
disturbance experiment, the analysis is focused in the position vector of ZMP based on CoP calculation in the 
X-axis similar with walk inplace experiment. During walk in place with right side force disturbance 
experiment, the analysis is focused in the position vector of ZMP based on CoP calculation in the Y-axis 
because position vector of ZMP based on CoP in Y-axis is dominant. Those experiments were doing with 
same walking locomotion parameters and in the flat floor (flat base). 


3.1. Walk in place 

This sub-section is explaining an implementation result of foot sensor modul using piezoelectric 
sensor during walking locomotion (walk in place). The implementation process is shown in Figure 10 and the 
result of foot sensor module calculation (position vector of ZMP based on CoP) is shown in Figure 11. 

Figure 10 is shows the walking locomotion process in the normal condition (without disturbance). 
T-FLoW humanoid robot needs 1.5 second to doing 1 full step of walk. From Figure 11, the calculation of 
position vector of ZMP based on CoP has maximum and minimum value (range) at 16 mm until -22 mm. 
The average value in positive area (forward direction in X-axis) has value at 0.8 mm and the average value in 
negative area (backward direction in X-axis) has value at -1.1 mm. From this data, the final conclusion of 
T-FLoW humanoid robot during walk in place has dominant characteristic walk in place with backward 
direction (with comparison about -0.3 mm). 
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Figure 10. Implementation process of foot sensor module using piezoelectric sensor during walking 
locomotion (walk in place) 


Position of CoP (Cm) in X axis 


Time (10ms) 


Figure 11. Position vector of ZMP based on CoP calculation during walk in place (without disturbance) 


3.2. Walk in place with forward force disturbance 

This sub-section is explaining an implementation result of foot sensor modul using piezoelectric 
sensor during walking locomotion (walk in place with forward force disturbance). The implementation 
process is shown in Figure 12 and the result of foot sensor module calculation is shown in Figure 13. 


Figure 12. Implementation process of foot sensor module using piezoelectric sensor during walking 
locomotion (walk in place with forward force disturbance) 
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Figure 13. Position vector of ZMP based on CoP calculation during walk in place with forward force 
disturbance 


Figure 12 is shows the walking locomotion process with forward force disturbance (with 
disturbance). T-FLoW humanoid robot needs 1.5 second to doing 1 full step of walk same with previous 
experiment. From Figure 13, the disturbance is applied during 275 ~ 960 of time periode. The calculation of 
position vector of ZMP based on CoP has maximum and minimum value (range) at 108 mm until -2 mm. 
The average value in positive area (forward direction in X-axis) has value at 86 mm and the average value in 
negative area (backward direction in X-axis) has value at -0.04 mm. From this data, the final conclusion of 
T-FLoW humanoid robot during walk in place has dominant characteristic walk in place with forward 
direction (with comparison about 85.96 mm). 


3.3. Walk in place with right side force disturbance 

This sub-section is explaining an implementation result of foot sensor modul using piezoelectric 
sensor during walking locomotion (walk in place with right side force disturbance). The implementation 
process is shown in Figure 14 and the result of foot sensor module calculation is shown in Figure 15. 


Figure 14. Implementation process of foot sensor module using piezoelectric sensor during walking 
locomotion (walk in place with right side force disturbance) 


Figure 14 is shows the walking locomotion process with right side force disturbance (with 
disturbance). T-FLoW humanoid robot needs 1.5 second to doing 1 full step of walk same with previous 
experiment. From Figure 15, the disturbance is applied during 250~1180 of time periode. The calculation of 
position vector of ZMP based on CoP has maximum and minimum value (range) at 28 mm until -72 mm. 
The average value in positive area (left side direction in Y-axis) has value at 1.4 mm and the average value in 
negative area (right side direction in Y-axis) has value at -68 mm. From this data, the final conclusion of 
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T-FLoW humanoid robot during walk in place has dominant characteristic walk in place with right side 
direction (with comparison about -66.6 mm). 


Position of CoP (Cm) in Y axis 


400 | | L 1 | 
0 200 400 600 800 1000 1200 
Time (10ms 


Figure 15. Position vector of ZMP based on CoP calculation during walk in place with right side force 
disturbance 


4. CONCLUSION 

From the 3 experiment which has been done. The final conclusion in first experiment is T-FLoW 
humanoid robot during walk in place has dominant characteristic walk in place with backward direction (with 
comparison about - 0.3 mm). The final conclusion in second experiment is T-FLoW humanoid robot during 
walk in place has dominant characteristic walk in place with forward direction (with comparison about 85.96 
mm). The final conclusion in third experiment is T-FLoW humanoid robot during walk in place has dominant 
characteristic walk in place with right side direction (with comparison about -66.6 mm). Based on those final 
conclusions in each experiment, the implementation of foot pressure sensor modul using piezoelectric sensor 
has a good result (94%) as shown in final conclusions in each experiment. The advantages of this new foot 
pressure sensor modul is low-cost design and similar result with another sensor such as flex sensor, loadcell 
sensor, and torque sensor. The disadvantages of this sensor are needed to recalculation because of the main 
characteristic of piezoelectric sensor (non-continuous read). Because of it, sometimes the calculation has 
outlayer data such as in the third experiment. But overall, the proposed model of foot pressure sensor modul 
in this research is work fine and already implemented in T-FLoW humanoid robot. 
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